NAVAL  POSTGRADUATE  SCHOOL 

Monterey,  California 


THESIS 


AIRBORNE  PASSIVE 

TARGET  MOTION  ANALYSIS 

t 

by 

Jay  A.  Gutzler 

September  1987 

Thesis  Advisor  H.  A. 

Titus 

Approved  for  public  release;  distribution  is  unlimited. 


iw: 


WWW 


WWW 


i«  report  secuaitv  CtASSlflCATlON 

UNCLASSIFIED 


it  SECURITY  CtASSlflCATlON  AuTmOAiTv 


/  ' •  /'  j  i 


REPORT  DOCUMENTATION  PAGE 


■ICTIVC  MARKINGS 


io  ofCiAiSi*/orio*/oo*v*G*AOiMG  schedule 


4  PlAfQAMiNG  ORGANIZATION  RE PORT  NuMBER(S) 


)  DISTRIBUTION/ Avam.ABu.iTV  Of  REPORT 
Approval  for  public  release;  distribution 
is  unlimited. 


S  MONITORING  ORGANIZATION  At  PORT  NUVBEA(S) 


6a  NAMt  Of  PC RfORMiNG  ORGANIZATION  |6o  Off'CE  SYMBOL  |  U  NAMf  Of  MONITORING  ORGANIZATION 

I  (ll  400f«4N«)  I 


Naval  Postgraduate  Softool 


6c  ADORE  SS  iC<ry  Sf4f#  *nd  tit  Cod*) 

Monterey,  California  93943-5000 


Naval  Postgraduate  School 


fb  ADDRESS  (City  SMTP  AndZiP  Cod*) 

Monterey,  California  93'M3-5000 


84  NAME  Of  fuNOiNG  I  SPONSORING 
ORGANIZATION 


8c  AOORfSSfCiry  S)4T*  *nd  Zip  Cod*) 


«b  OffiCE  STMtOl  |  4  P*OCuR£MENT  INSTRUMENT  lOt  N  l<l  'C  A  TiON  NUMBER 
(ll  tpolxtbf) 


10  SOURCE  Of  fuNOiNG  NuMRIRS 


PROGRAM 

ELEMENT  NO 


PROJECT 

NO 


TASK 

WORK  JNIT 

NO 

ACCCSS  ON  NO 

*  !  \E  (mclud*  S#cuciiy  CUmlKStiOnl 

AIR30RNE  PASSIVE  TARCET  MOTION  ANALYSIS 


•;  PERSONA,  AuTmOA(S) 

CUTZLER,  Jav  A. 


>4  0‘  REPORT 

Master's  Thesis 


6  Sl  pp,(  ME  N T ARt  notation 


)o  T  ME  COVERED 
f«OM  tO 


U  DATE  Of  REPORT  |V*4»  Mo«fN  0*t>  I’S  PAGE  CO^NT 


t|  SutiECT  TfRMS  <Co**«'rt«i*  o«  i*v*/y*  if  nf<*U4i>  4« I  xfrnt.fy  By  bloc*  »ui"S»i| 


Airborne  Tracking 


4  ABSTRACT  (ConliKu*  0«  'HM*  if  n*<*U4ry  IN)  by  No c*  n»mB»rl 

,  ^  Kalman  filtering  techniques  are  applied  to  a  two  sensor  bearings 
only  passive  target  motion  analysis  problem.  An  algorithm  is  developed 
to  simulate  tracking  long  range  maneuvering  airborne  targets.  The  target 
tracking  performance  of  the  filter  is  evaluated  using  computer  generated 
noisy  bearing  measurements.  The  performance  of  the  filter  is 
satisfactory  given  reasonable  initial  conditions  and  measurement  noise. 


.0  D  S'R  JuT'ON  I  AVAilABU'Tt  0«  ABSTRACT  ji<  ABSTRACT  SECURltv  CLASS'f 'CA'iON 

G3  -NCiASSif'f OAlNl'MlTf o  □  SAME  AS  APT  □  QTiC  uSE»S  I  UNCLASSIFIED _ 


lit  NAME  Of  RESPONSIBLE  ND'ViOuAl  TjZb  TELEPHONE  fiNCivd*  Ar»#Cod*)  ZZt  0>f'U  S»MBOl 

Prof  H.  A.  Titus  I  (406)  646-2156  62  Ts 


00  FOAM  1471.  l«  mar 


•  )  APR  ut'l-on  *•»  bt  v»*0  v"M  »iT<4utt4d 
am  et''*'  •a  i'OTn  4'«  ebtoiptR 


SECuR'Tt  CLASS't'CATiQN  Of  T»'S  PAGE 


.  - 


Approved  for  public  release;  distribution  is  unlimited. 


Airborne  Passive 
Target  Motion  Analysis 


by- 


Jay  A.  Gutzler 

Lieutenant,  United  States  Navy 
B.S.,  U.S.  Naval  Academy,  1980 


Submitted  in  partial  fulfillment  of  the 
requirements  for  the  degree  of 


MASTER  OF  SCIENCE  IN  SYSTEMS  ENGINEERING 
(ELECTRONIC  WARFARE) 

from  the 


NAVAL  POSTGRADUATE  SCHOOL 
September  1987 


ABSTRACT 


Kalman  filtering  techniques  are  applied  to  a  two  sensor  bearings  only  passive 
target  motion  analysis  problem.  An  algorithm  is  developed  to  simulate  tracking  long 
range  maneuvering  airborne  targets.  The  target  tracking  performance  of  the  filter  is 
evaluated  using  computer  generated  noisy  bearing  measurements.  The  performance  of 
the  filler  is  satisfactory  given  reasonable  initial  conditions  and  measurement  noise. 


Accession  For 


NTIS  GRA&I 
DTIC  TAB 
Unannounced 
Justification 


By - 

Distribution/ 


Availability  Codes 
Avail  and/or 
Special 


Dlst 


THESIS  DISCLAIMER 


The  reader  is  cautioned  that  computer  programs  developed  in  this  research  may 
not  have  been  exercised  for  all  cases  of  interest.  While  every  effort  has  been  made, 
within  the  time  available,  to  ensure  that  the  programs  are  free  of  computational  and 
logic  errors,  they  cannot  be  considered  validated.  Any  application  of  these  programs 
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I.  INTRODUCTION 


Air  defense  of  a  carrier  battle  group  is  becoming  significantly  more  complex  due 
not  only  to  the  increased  speed  and  range  of  potentially  hostile  aircraft  but  also  to 
more  capable  enemy  targeting  systems  and  greater  cruise  missile  ranges.  To  reduce  the 
probability  of  an  aircraft  carrier  being  successfully  targeted  by  an  enemy  cruise  missile 
earning  aircraft,  it  is  imperative  that  fighter  intercept  be  accomplished  beyond  the 
maximum  range  of  the  cruise  missile.  Long  range  over-the-horizon  (OTH)  target 
detection  and  tracking  are  necessary  to  achieve  this  goal. 

A  major  obstacle  common  to  all  air  defense  scenarios  is  the  enemy's  use  of 
electronic  countermeasures  (ECM).  Attacking  enemy  aircraft  will  undoubtedly  employ 
jamming  as  well  as  other  forms  of  ECM  to  degrade  or  deny  effective  tracking  by  active 
systems.  Therefore,  the  ability  to  passively  track  is  required  in  order  to  successfully 
engage  attacking  aircraft  in  a  dense  ECM  environment. 

One  viable  approach  to  this  problem  is  passive  Target  Motion  Analysis  (TMA). 
The  purpose  of  TMA  is  to  determine  the  target's  position,  course  and  speed  through  a 
scries  of  passive  noisy  measurements.  For  the  air  defense  scenario,  these  passive 
measurements  may  be  lines  of  bearing  (LOB)  obtained  from  the  enemy  aircraft's 
jamming  strobes  or  from  the  electromagnetic  radiation  of  the  aircraft's  long  range 
targeting  radar.  f'T'h <J  )  '  "  ' 

Passive  bearings  only  TMA  may  be  performed  by  one  or  more  sensors.  The  two 
primary  considerations  in  evaluating  TMA  performance  are  solution  accuracy  and 
timeliness.  Single  sensor  TMA  requires  that  the  observer  aircraft  perform  zig  zag 
maneuvers  to  establish  a  target  bearing  rate  so  that  the  range  to  the  target  may  be 
estimated.  One  drawback  to  single  sensor  TMA  is  the  fact  that  these  maneuvers  may 
detract  from  the  observer  aircraft's  primary  mission.  Also,  a  reasonable  initial  estimate 
of  the  target's  state  (position,  course  and  speed;  is  necessary  to  ensure  that  the  tracking 
solution  converges  in  a  timely  manner,  if  indeed  it  converges  at  all.  An  inherent 
difficulty  with  bearings  only  TMA  by  a  single  sensor  is  that  the  solution  accuracy  and 
timeliness  rely  quite  heavily  upon  a.  "good"  a  priori  estimate  of  target  range. 
Consequently,  in  a  long  range  tracking  scenario  where  the  range  to  the  target  may 
exceed  several  hundred  miles,  accurate  tracking  by  a  single  sensor  using  only  bearing 
observations  is  extremely  arduous  and  rather  impractical. 


A  practical  solution  to  long  range  OTH  passive  tracking  is  multi-sensor 
triangulation.  High  speed  air  targets  can  be  accurately  tracked  by  two  or  more  highly 
directional  sensors  that  are  spaced  sufficiently  far  apart.  The  primary  reason  that  multi¬ 
sensor  tracking  is  superior  to  single  sensor  TMA  is  that  estimates  of  target  range  are 
continually  being  generated  through  triangulation  of  sensor  bearing  lines.  Multi-sensor 
tracking  is  far  less  dependent  on  accurate  a  priori  state  estimates  than  is  single  sensor 
tracking  for  timely  convergence.  The  major  obstacle,  however,  in  using  the  multi-sensor 
triangulation  method  is  a  practical  one:  very  close  cooperation  is  required  between  the 
observers  in  order  to  achieve  an  accurate  tracking  solution.  Three  ingredients  are 
required  to  localize  a  target:  the  position  of  each  sensor,  the  time  of  the  observation, 
and  the  bearing  measurement  from  each  sensor.  Ideally,  all  observations  would  be 
performed  synchronously.  If  asynchronous  lines  of  bearing  are  encountered,  then 
computer  processing  is  required  to  interpolate  these  LOB's  to  produce  “synchronous" 
measurements.  The  observers  are,  in  effect,  remote  sensors  that  transmit  noisy  bearing 
data  to  a  central  processing  platform  where  the  actual  target  tracking  is  performed.  For 
tracking  a  long  range  and  rapidly  closing  air  target,  triangulation  provides  a 
significantly  more  accurate  and  timely  tracking  solution. 

Because  each  sensor  generates  its  own  sequence  of  noisy  bearing  observations, 
the  Kalman  filter  is  ideally  suited  for  determining  a  target's  position  and  motion.  This 
thesis  investigates  the  two  sensor  bearings  only  tracking  problem  in  a  computer 
simulation  that  employs  Kalman  filtering  techniques.  The  simulation  generates  the 
target  and  observer  tracks  as  well  as  noisy  bearing  measurements  from  each  sensor  to 
the  target.  The  noisy  bearings  are  then  processed  by  the  Kalman  filter  to  provide 
continual  estimates  of  the  target's  state.  The  tracking  algorithm  is  used  in  several 
scenarios  to  determine  the  effect  various  sensor  bearing  accuracies  and  initial  estimates 
have  on  the  filter's  performance. 

The  aim  of  this  research  is  to  examine  how  well  the  filter  performs  in  tracking  a 
non-maneuvering  target  before  investigating  the  more  difficult  case  of  a  maneuvering 
target.  The  problem  geometry  wiii  be  presented  first,  foiiowed  by  the  development  of 
the  system  and  measurement  models.  Relevant  equations  from  Kalman  filtering  theory- 
will  then  be  briefly  reviewed  before  the  actual  tracking  algorithm  is  analyzed  in  detail. 
The  results  of  several  simulation  runs  using  various  parameters  will  be  examined.  Also, 
the  effect  of  target  maneuvers  on  filter  stability  will  be  assessed.  The  final  chapter  will 
summarize  the  results  of  this  research  and  will  present  conclusions  and 
recommendations  for  further  study. 
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II.  PROBLEM  DESCRIPTION 

A.  INTRODUCTION 

As  the  name  implies,  over-the-horizon  detection  and  tracking  means  positioning 
sensors  out  near  the  radar  horizon  to  look  over  the  edge  and  pass  their  observations 
back  to  a  central  data  fusion  point  for  analysis.  This  data  fusion  point  need  not  be  a 
surface  combatant;  it  could  be  a  command  and  control  aircraft.  The  use  of  an  airborne 
command  and  control  platform  extends  the  range  to  which  an  air  target  can  be 
effectively  tracked.  The  basic  idea  behind  OTH  tracking  is  to  place  the  remote  sensors 
far  enough  apart  so  that  effective  triangulation  fixes  may  be  taken  but  not  so  far  apart 
that  they  are  beyond  the  range  at  which  they  can  communicate  with  the  central 
processing  platform.  The  command  and  control  aircraft  should  ideally  be  positioned  on 
the  threat  axis  between  the  incoming  air  attack  and  the  high  value  unit  (HVU)  that  is 
being  protected.  Figure  2.1  depicts  the  general  geometry  of  a  basic  OTH  detection  and 
tracking  scenario. 
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Figure  2.1  Basic  Over-the-Honzon  Detection  and  Tracking  Scenario. 


In  this  chapter  the  geometry  of  the  two  sensor  TMA  problem  will  be  presented 
along  with  a  development  of  the  target  motion  and  noise-free  measurement  equations. 


B.  PROBLEM  GEOMETRY 

Consider  the  target-observer  geometry  in  the  two  dimensional  plane  as  shown  in 


Figure  2.2.  The  target  is  located  at  (xy  ,  >y)  from  a  defined  reference  position.  The 
origin  may  be  defined  as  cither  a  fixed  latitude 'longitude  coordinate  or  the  position  of 
a  high  value  unit  such  as  an  aircraft  carrier  (whose  position  is  relatively  stationary). 
The  x  and  y  components  of  target  velocity  are  denoted  as  Xy  and  >’y  and  are  the 
Cartesian  equivalents  of  the  target's  course  and  speed,  Cy  and  Vy.  Sensor  1  is  located 
at  (Xj  .  0)  and  is  only  able  to  move  along  the  x-axis  with  velocity  xr  Likewise,  sensor  2 
is  located  at  (0  ,  y,)  and  is  only  able  to  move  along  the  y-axis  with  velocity  y,.  As 
cho-vrn  in  F;anr?  2.2,  the  bearin'*  from  1  to  the  targe*  i<  ft  and  the  ^earing  from 

sensor  2  to  the  target  is  02>  The  ranges  to  the  target  from  sensors  1  and  2  are  denoted 
as  t1  and  r2  respectively,  and  the  range  of  the  target  from  the  origin  is  denoted  Ry. 

I.  Problem  Assumptions 

The  following  assumptions  are  made  concerning  the  problem: 

1.  The  target  is  initially  inbound  and  remains  within  the  first  quadrant. 

2.  The  target  maintains  a  constant  speed  but  is  free  to  change  course. 
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3.  Both  sensor  positions  are  known  precisely. 

4.  Bearing  data  from  each  sensor  are  continuously  observed  and  are  received 
synchronously. 

5.  Bearing  noise  is  zero  mean  and  Gaussian  with  variances  <rL2  and  <r22  for  sensors 
1  and  2,  respectively. 

6.  Target  turns  are  modeled  as  instantaneous  (i.e.,  no  turn  radius). 

7.  Target  and  sensor  altitudes  have  negligible  effect  at  long  ranges. 

The  last  assumption  is  entirely  reasonable  since  the  difference  between  the  target's 
slant  range  and  two  dimensional  range  is  less  than  a  fraction  of  1%  for  ranges 
exceeding  300  nautical  miles. 

2.  Practical  Geometrical  Considerations 

Placing  the  airborne  sensors  on  orthogonal  axes  is  chosen  not  only  because  it 
simplifies  the  geometry  but  also  because  it  provides  adequate  sensor  separation  with 
which  to  perform  accurate  triangulation.  Ideally,  the  most  accurate  triangulation  fix  is 
formed  from  the  intersection  of  two  perpendicular  lines  of  bearing.  Perpendicular 
LOB's  in  real  world  scenarios,  however,  are  extremely  difficult  to  obtain  for  a  number 
of  reasons.  One  reason  is  that  the  maximum  range  and  on  station  time  for  airborne 
sensors  are  limited.  Also,  if  electromagnetic  energy  from  the  target  is  being  used  to 
obtain  LOB  s,  it  is  important  that  both  sensors  be  positioned  within  the  main  sector 
beam  pattern.  Figure  2.3  illustrates  some  of  these  considerations.  In  Figure  2.3  (a),  it 
can  be  seen  that  in  the  attempt  to  obtain  perpendicular  LOB's  to  the  target,  sensor  1  is 
beyond  the  radar  horizon  of  the  command  and  control  aircraft  and  is  thus  unable  to 
pass  any  bearing  observations.  Figure  2.3  (b)  shows  both  sensors  lying  within  the 
sector  scan  limits  of  the  target's  surveillance  radar.  While  it  is  not  necessary  for  both 
sensors  to  be  within  the  main  beam  simultaneously,  both  must  be  able  to  detect  the 
beam's  presence  within  a  reasonable  time  period,  a  factor  which  depends  on  the  radar  s 
scan  rate. 

The  scenano  where  the  sensors  are  positioned  on  orthogonal  axes  could  easily 
be  modified  to  the  mere  general  case  where  the  sensors  are  iocated  on  radials  that  are 
separated,  say,  by  60  degrees.  Since  the  sensors  are  now  closer  together,  range 
estimates  to  the  target  would  be  somewhat  degraded.  Also,  by  adding  a  third  sensor  on 
a  radial  120  degrees  from  the  first  sensor  and  60  degrees  from  the  second  would 
provide  a  wider  sector  coverage  as  well  as  improved  tracking  accuracy. 

The  simulations  that  have  been  run  in  this  thesis  involve  extreme  ranges  from 
each  sensor  to  the  target.  It  has  been  assumed  throughout  that  the  target  and  sensor 
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Figure  2.3  Practical  Geometric  Considerations. 

aircraft  are  flying  at  medium  to  high  altitudes  so  that  all  observations  will  meet  radar 
horizon  range  constraints.  It  should  be  noted,  however,  that  the  practical  limiting 
factors  for  maximum  detection  range  are  the  strength  and  radio  frequency  (RF)  of  the 
intercepted  source  signal.  Also,  bearing  accuracies  depend  on  the  RF  of  the  signal. 
Extreme  detection  ranges,  sometimes  between  400  and  500  nautical  miles,  have  been 
used  to  represent  a  worst  case  tracking  problem;  shorter  ranges  would  yield  a  more 
accurate  tracking  solution. 


C.  SYSTEM  MODEL 


As  shown  in  Figure  2.2,  lines  of  bearing  from  two  airborne  sensors  arc  used  to 
determine  the  target's  state  (position,  course  and  speed).  Using  a  Cartesian  coordinate 
system,  a  four  dimensional  state  vector,  Xy,  is  chosen. 


XT 


(eqn  2.1) 


It  should  be  noted  that  the  system  model  is  in  no  way  limited  to  a  Cartesian  reference 
frame  or  state  vector;  the  Cartesian  coordinate  system  was  chosen  merely  for  its 
mathematical  simplicity. 
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1.  Target  Maneuvers 

Two  basic  scenarios  are  addressed  in  this  thesis.  The  first  one  involves 
tracking  a  non-maneuvering  target  and  the  second  involves  a  maneuvering  target.  In 
both  cases  the  target  is  assumed  to  be  initially  inbound  and  any  target  maneuver  will 
consist  of  the  target  changing  only  its  course  and  maintaining  its  speed.  Figure  2.4 
shows  the  target  tracks  that  will  be  examined  in  subsequent  chapters. 


Figure  2.4  Representative  Target  Tracks. 

It  is  assumed  that  target  maneuvers  can  be  modeled  by  using  white  random 
forcing  functions.  As  shown  in  Figure  2.5,  target  maneuvers  may  be  thought  of  as 
acceleration  along  its  course  (radial  acceleration)  and  acceleration  perpendicular  to  its 
course  (turn  rate).  Let  the  random  variables  6-  and  6^  denote  the  target's  acceleration 
along  its  course  and  acceleration  perpendicular  to  its  course,  respectively.  Both  6.  and 
6^  denote  random  changes  of  the  target  and  are  assumed  to  be  independent  and  zero 
mean  with  variances  <T.2  and  <r^*.  Because  of  the  extremely  long  ranges  involved  in  the 
simulations,  target  maneuvers  have  been  modeled  as  instantaneous  chances  cf  position 
according  to  the  time  interval  used.  That  is,  the  simulation  enables  the  target  to  turn 
90°  in  two  seconds.  While  it  is  acknowledged  that  this  kind  of  turn  rate  is  quite 
artificial,  it  is  informative  to  see  what  effect  such  a  drastic  turn  rate  has  on  tracking 
performance  and  stability.  The  variances  used  in  subsequent  scenarios  are: 


<J$2  ■  (300knots/sec)2 


(eqn  2.2) 


I  <r$2  =  (45  deg:  sec)2  (eqn  2.3) 
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Figure  2.5  Geometry  of  Target  Maneuvers. 
a .  Equations  of  Motion 

Let  T  represent  the  time  interval  between  observations.  If  k  represents  the 
k*  observation  and  tk  the  discrete  time  of  the  k*  observation,  then  T  may  be 
expressed  as 


T  -  tk  -  tk.j  (eqn  2.4) 

Referring  to  Figure  2.2  and  Figure  2.5,  target  motion  may  be  described  by  the 
difference  equations: 


SrO**  i) 


xj(k+0 

"xj(k)  +  T  Xj(k)  +  f^Sy,  60,  k“ 

xT(k+  l) 

_ 

xj(k)  +  f2(6v,  50,  k) 

y-T<k+l) 

yj(k)  +  T  yj(k)  +  f3(8v,  50.  k) 

yT(k+  1) 

yj(k)  +•  f4(6v,  80,  k) 

(eqn  2.5) 
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The  random  forcing  functions  fj  through  f4  are  included  to  account  for  random 
changes  in  speed  and  heading  which  occur  for  a  moving  target.  Equation  2.5  may  be 
written  in  matrix  form  as 

1  T  0  0  p^k)]  [t2/2  0  1 

0  10  0  xj<k)  T  0  fxy(k) 

x(k+ 1)  -  0  0  1  T  yj{k)  0  T2/2  y-j-fk)  (eqn  2.6) 

0  0  0  1  yj<k)  0  T 

or  more  concisely  as 

xk+l  -  *kxk  +  Fkwk  (eqn  2.7) 

where  is  the  4  x  i  state  vector 

d>k  is  the  4  x  4state  transition  matrix 

ivj.  is  the  2  x  l  vector  of  random  forcing  functions 

Tj.  is  the  4  x  2  state  forcing  matrix. 

The  terms  of  the  random  forcing  function  vector  represent  the 
accelerations  in  the  x  and  y  directions  caused  by  target  maneuvers.  The  state  forcing 
matrix  Tj.  represents  a  uniform  constant  acceleration  model  of  target  motion.  If  the 
time  interval  T  between  measurements  is  assumed  constant,  then  may  be  replaced 
by  a  constant  state  transition  matrix  <J>  and  1"^  may  be  replaced  by  a  constant  state 
forcing  matrix  I*.  Revising  Equation  2.7,  the  linear  system  model  can  be  expressed  as 

xk+l  =  ®  xk  +  *"wk  (eqn  2.8) 


D. 


NOISE-FREE  MEASUREMENT  EQUATION 

As  illustrated  in  Figure  2.2.  the  positions  of  sensors  1  and  2  along  with  their 
respective  bearings  to  the  target.  0j  and  0,,  uniquely  define  the  target's  position  (Xj, 
Yj).  The  target's  position  from  noise-free  bearing  observations  may  be  expressed  as 


*T  = 


(y2  cos  0j  -  Xj  sin  0t)  sin  02 


cos(0t  +  02) 


(eqn  2.9) 
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(x.  cos  0,  -  y,  sin  0,)  sin  0, 

‘ - 


(eqn  2.10) 


The  positions  and  speeds  for  the  airborne  sensors  may  be  chosen  arbitrarily  for 
input  into  the  tracking  algorithm.  Each  sensor's  position  is  assumed  to  be  known 
precisely  for  each  time  interval.  The  sensors  may  both  head  inbound  or  outbound  or 
they  may  go  in  alternate  directions.  Care  must  be  exercised  in  choosing  sensor 
positions  and  speeds  so  as  to  avoid  having  lines  of  bearing  that  are  collinear  (each 
sensor  is  pointing  at  the  other).  What  results  in  this  case  is  an  extremely  thin  and 
elongated  error  ellipse  which  momentarily  degrades  tracking  accuracy  at  the  moment 
that  the  lines  of  bearing  are  coincident. 

It  should  be  noted  that  using  two  sensors  eliminates  the  need  for  any  extraneous 
observer  maneuvering  as  is  the  case  for  a  single  sensor.  The  observer  aircraft  can 
basically  fiv  straight  and  level  and  collect  more  reliable  bearings  to  the  target.  Also,  the 
sensor's  position  is  known  more  precisely  since  it  is  not  decelerating  and  accelerating 
into  and  out  of  turns. 


III.  KALMAN  FILTERING 


A.  INTRODUCTION 

The  technique  of  Kalman  filtering  is  ideally  suited  to  the  problem  of  passive 
tracking.  The  following  sections  briefly  describe  the  theory  and  results  of  Kalman 
filtering  and  how  it  is  applied  to  the  long  range  airborne  TMA  problem.  For  a  more  in- 
depth  development  of  the  Kalman  filter,  the  reader  is  referred  to  [Refs.  1,2]. 

B.  THE  KALMAN  FILTER 

The  purpose  of  the  Kalman  filter  is  to  keep  track  of  the  state  of  a  system 
through  a  sequence  of  noisy  measurements.  This  is  accomplished  by  recursively 
updating  an  estimate  of  the  state  by  processing  a  sequence  of  noisy  observations  in 
such  a  manner  as  to  reduce  as  much  as  possible  the  effect  of  measurement  errors. 

The  Kalman  filter  is  a  predictor-corrector  type  estimator  that  propagates  an 
estimate,  x,  of  the  target  state  along  with  an  associated  covariance  matrix,  P,  which 
reflects  the  degree  of  confidence  placed  in  the  accuracy  of  the  state  estimate.  The 
Kalman  filter  is  carried  out  in  two  alternating  stages.  First,  previous  estimates  of  x 
and  P  are  extrapolated  one  time  step  ahead  based  on  the  assumed  system  dynamics; 
this  is  referred  to  as  the  Movement  Step.  These  extrapolated  values  are  then  used  to 
compute  a  set  of  optimum  weights  called  Kalman  gains.  The  gains  are  applied  to  the 
prediction  and  to  a  new  observation  in  a  Measurement  Step,  which  provides  an 
updated  estimate  of  the  state  and  its  covariance.  This  process  is  then  repeated.  [Ref.  3] 

1.  Assumptions 

The  following  assumptions  are  made: 

1.  The  random  forcing  function  is  zero  mean  and  uncorrelated  with  covariance 

Qk 

2.  The  measurement  noise  is  zero  mean  and  is  correlated  with  covariance  Rj.. 

3.  The  random  forcing  function  Wj.  and  measurement  noise  are  uncorrelatcd. 

4.  The  initial  state  xQ  is  a  random  variable  with  known  mean  xn).]  and  covariance 

po|-r 


2.  Definitions 


1.  The  estimated  state  vector  after  k  observations  is  denoted  by  and  the 
predicted  state  vector  before  the  observation  is  represented  by  xk|k.j. 


2.  The  state  estimation  error  vector  £k  is  defined  as  the  difference  between  the 
estimated  state  and  the  true  state 


h  M  xk|k  xk 


(eqn  3.1) 


and  the  predicted  state  estimation  vector  £k  k  ,  is  defined  as  the  difference  between 
the  predicted  state  and  the  true  state 


Cklk-1  S  \lk-l  “  xk 


(eqn  3.2) 


3.  The  covariance  of  estimation  error  matrix  Pk)k  is  defined  as 


Phi,  E{  ) 


(eqn  3.3) 


and  the  predicted  covariance  of  state  error  matrix  Pk|k.j  is  defined  as 


Pklk-i  “  E'  cyk-i  Ck/T k-i  ) 


(eqn  3.4) 


4.  The  state  excitation  covariance  matrix  is  given  by 


Q.  *  E{  T  w.  w.  T  rT } 


(eqn  3.5) 


5.  The  Kalman  filter  is  an  optimal  estimator  that  minimizes  the  sum  of  the 
variances  of  the  estimation  error,  i.e.. 


H{Cj(k)2}  -  Efc,(k)2}  +  .  . .  +  E(en(k)2} 


(eqn  3.6) 


,  .S  * 

•/*  ■ 


Enter  known  matrices  and  a  priori  estimates: 
‘(Oj-1)’  P(0|-l)  •  R(0)>  H*  ® 

Compute  the  Kalman  gain: 

;(k)  =  P(k|k-1)HT'  HP(k|k-l)HT  +  ^k)^'1 

MEASUREMENT  STEP 

SCklk)  =  *(k|k-I)  +  c(k)'  z(k)  ~  H*(klk-l)  > 
*(k|k)  =  '  1  “  G(k)H  >p(k!k-l) 

MOVEMENT  STEP 

‘(k+llk)  =  °%!k) 

*(k+l|k)  "  ^(klk)^1  +  Q(k) 

Compute  R^)  and 
Increment  k  by  1 


Figure  3.1  Kalman  Filter  Algorithm. 
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3.  Kalman  Filter  Algorithm 

Figure  3.1  summarizes  the  discrete  Kalman  filter  algorithm.  For  the  particular 
TMA  problem  presented  in  this  thesis,  the  2  x  4  measurement  matrix  Hfc  and  the  4  *  4 
state  transition  matrix  <Dk  are  both  known,  constant  matrices  and  may  be  represented 
by  H  and  O.  An  a  priori  estimate  Xq^j  of  the  target's  state  with  an  associated  initial 
error  covariance  matrix  as  well  as  an  initial  estimate  of  the  measurement  noise 
covariance  matrix  RQ  must  be  input  into  the  filter  algorithm.  The  algorithm  computes 
the  Kalman  gain  Gk  based  on  these  a  priori  values  and  then  updates  the  estimate  of 
the  target's  state  when  it  receives  a  measurement.  The  error  covariance  matrix  is  also 
updated.  Next,  the  state  estimate  and  its  error  covariance  matrix  are  projected  one  time 
step  ahead  based  on  the  assumed  system  dynamics.  The  measurement  noise  covariance 
Rk  and  the  state  excitation  covariance  matrix  Qk  are  then  computed  before  k  is 
incremented  by  one  and  the  whole  process  is  repeated. 


C.  FUNCTIONS,  MATRICES,  AND  EQUATIONS 

In  this  section,  the  Kalman  filter  algorithm  will  be  applied  to  the  long  range 
passive  airborne  tracking  problem.  A  brief  derivation  of  the  random  forcing  function 
»k<  the  state  excitation  covariance  matrix  Qk,  the  measurement  equation  zk,  and  the 
measurement  noise  covariance  matrix  Rk  is  given  next. 

1.  Random  Forcing  Function 

Recalling  equation  (2-6),  the  two  dimensional  random  forcing  function  «k 
represents  the  acceleration  in  the  x  and  y  directions  caused  by  target  maneuvers. 


w  _  pf|  _  r  >a  +  <4 
_[?kJ  "  [-hh  + 


(eqn  3.7) 


where  vk  =  (  xk2 


yk2  )»« 


Since  the  random  variables  5,  and  5a  were  assumed  to  be  zero  mean,  it 


follows  that  the  random  forcing  function  \  is  also  zero  mean.  The  variances  of  the  x 


and  y  accelerations,  denoted  by  c  -  and  a-~  respectively,  are 

a  y 


V  -  efrj  -  i‘ «»  *  fe)V 

V  • 


(eqn  3.S) 


(eqn  3.9) 


,  .■» 
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The  covariance  of  the  x  and  y  acceleration  a—.2  is 

xy 


V  -  £[;»y.]  =  -Kid  («q»  3- “» 


Therefore,  the  random  forcing  function  covariance  matrix  Q. '  is 


Qv  =  wk  wkl  ) 


a-1.. 

X  °«y 


(eqn  3.1 1) 


where  af  ,  ffy2  ,  and  <x- y2  are  computed  at  the  predicted  values  of  x j  and  y j. 

2.  State  Excitation  Covariance  Matrix 

The  purpose  of  the  state  excitation  covariance  matrix  Qk  is  to  account  for 
model  inaccuracies  or  for  a  target  that  has  maneuvered.  It  is  basically  a  "procedure  for 
masking  the  effects  of  modeling  errors"  [Ref.  2:  p.  163].  In  effect,  the  state  excitation 
covariance  matrix  increases  the  size  of  the  predicted  covariance  of  error  matrix  which 
in  turn  increases  the  filter  gains.  As  more  observations  are  processed,  Qk  prevents  the 
Kalman  gains  from  approaching  zero  by  continually  injecting  uncertainty  into  the 
predicted  state  estimate  at  each  iteration.  A  nonzero  Qk  slightly  degrades  the  filter  s 
accuracy  when  the  target  is  not  maneuvering  but  it  helps  prevent  filter  divergence  when 
the  target  docs  maneuver.  As  stated  in  equation  3.5.  the  state  excitation  covariance 
matrix  is 


Qt  -  r  Qk'  rT  - 


3.  Measurement  Equation 

In  this  TMA  problem,  the  observations  are  noisy  (x.y)  positions.  It  is  the 
intersection  of  noisy  lines  of  bearing  that  form  the  noisy  (x.y)  position  of  the  target 
that  is  input  into  the  Kalman  filter  algorithm.  Because  the  observations  are  of  the 
same  form  as  the  state  vector,  the  measurement  equation  is  linear  and  is  expressed  as 
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(eqn  3.12) 


where 


zk  is  the  2  *  1  measurement  vector 
H  is  the  2  *  4  measurement  matrix 
vk  is  the  2  *  1  measurement  noise  vector 
xk  is  the  4  x  1  state  vector. 

The  equation  may  be  written  explicitly  as 


(eqn  3.14) 


The  most  important  part  of  the  measurement  equation  is  an  accurate  description  of  the 
measurement  noise  vector  vk  The  measurement  noise  vector  expresses  the  statistical 
nature  of  the  noisy  (x,y)  position  that  is  derived  from  the  intersection  of  two  noisy  lines 
of  bearing.  These  bearing  measurement  errors  are  assumed  to  be  independent  and  zero 
mean  with  variances  and  <r22,  for  sensor  1  and  sensor  2  respectively. 

It  is  important  to  note  that  the  bearing  errors  between  sensors  are  statistically 
uncorrelated;  one  sensor  s  bearing  accuracy  has  nothing  to  do  with  any  other  sensor's 
beanng  accuracy.  However,  in  describing  the  resulting  intersection  in  Cartesian 
coordinates,  the  noisy  x  and  noisy  y  positions  are  correlated.  The  only  case  where  the 
noisy  x  and  noisy  y  positions  are  uncorrelated  is  when  the  lines  of  bearing  are 
perpendicular. 

4.  Error  Ellipses 

An  intuitive  way  to  visualize  the  measurement  equation  is  through  the  concept 
of  error  ellipses.  Error  ellipses  give  a  geometric  picture  of  the  region  around  a  noisy 
position  or  estimate  where  the  true  value  is  considered  to  lie.  Figure  3.2  shows  a 
|  dcn*itv  function  farmed  th®  !ntcr*?ct!cn  cf  t,vo  !!n?c 

i 

i  of  bearing  with  independent  Gaussian  distributions. 

As  can  be  seen  in  Figure  3.2,  the  lines  of  bearing  intersect  at  an  oblique  angle, 
forming  an  asymmetric  hump.  While  the  bivariate  Gaussian  probability  density 
J  function  gives  an  interesting  three  dimensional  depiction  of  two  normally  distributed 

|  beanng  errors,  it  does  not  provide  the  information  that  is  really  needed,  quickly.  What 

I 
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Figure  3.2  Bivariate  Gaussian  Probability  Density  Function. 

is  needed  is  an  accurate  picture  of  the  measurement  {or  estimation)  error.  This 
uncertainty  is  best  expressed  geometrically  by  the  error  ellipse.  The  term  "error  ellipse" 
refers  to  the  two  dimensional  surface  of  constant  probability  density.  Figure  3.3 
presents  these  error  ellipses  as  contour  lines  of  the  bivariate  Gaussian  probability 
density  function  shown  in  Figure  3.2. 

The  various  ellipse  sizes  in  Figure  3.3  correspond  to  different  constant 
probabilities.  The  fact  that  the  ellipses  are  also  rotated  implies  that  the  uncertainty  in 
measurement  error  is  indeed  correlated  with  respect  to  x  and  y.  The  actual  probabilities 
within  a  specified  error  ellipse  may  be  computed  through  lengthy  integration  of  the 
bivariate  Gaussian  probability  density  function  over  the  surface  of  the  ellipse.  Some 
computed  probabilities  of  the  true  value  lying  within  the  lo,  2tr.  and  3<r  error  ellipses 
are  .394,  .865,  and  .989  respectively  [Ref.  4:  pp.  4-49). 

Error  ellipses  are  extremely  useful  in  examining  postion  error.  Matrices 
containing  the  x  and  y  position  terms  convey  analytically  what  error  ellipses  display 
graphically.  A  2  x  2  error  covariance  matrix  which  contains  position  components  x  and 
y  is  able  to  completely  describe  an  ellipse.  The  main  diagonal  terms  represent  the 


Figure  3.3  Error  Ellipses  as  Contour  Lines. 
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variances  of  the  x  and  v  positions  respectively.  The  off  diagonal  terms  represent  the 
degree  of  x-y  coupling  and  the  orientation  of  the  error  ellipse  in  the  x-y  plane. 

5.  Covariance  of  Measurement  Error  Matrix 

The  covariance  of  measurement  error  matrix  Rk  uses  the  concept  of  error 
ellipses  to  accurately  describe  the  noisiness  and  degree  of  coupling  of  (x,y) 
measurements  obtained  from  intersections  of  noisy  LOB's.  The  terms  of  the  covariance 
of  measurement  error  matrix  Rk  depend  on  the  standard  deviations  of  bearing  error  <Tj 
and  <j2  of  sensors  1  and  2  as  well  as  the  angle  at  which  the  lines  of  bearing  intercept. 
The  covariance  of  measurement  error  may  be  expressed  as 
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where  0j  and  02  denote  noisy  bearing  observations  from  sensors  1  and  2,  respectively. 
The  subscript  k  has  been  intentionally  deleted  from  equation  (3-15)  only  for  ease  of 
notation.  At  each  discrete  time  interval  tk,  new  values  of  and  02  are  generated  with 
which  to  compute  the  new  measurement  error  covariance  matrix,  Rk  A  complete 
derivation  of  equation  (3-15)  is  given  in  Appendix  A  for  the  interested  reader. 


IV.  THE  ALGORITHM 


A.  INTRODUCTION 

This  section  discusses  the  development  of  the  tracking  algorithm.  The  algorithm 
is  designed  to  simulate  tracking  a  long  range  inbound  enemy  air  target  by  triangulating 
noisy  bearing  observations  from  two  airborne  sensors.  We  want  to  be  able  to  track  a 
non-maneuvering  target  within  a  one  percent  range  error.  For  a  maneuvering  target, 
we  desire  a  stable  filter  response  which  quickly  converges  to  the  target's  new  state.  The 
effect  of  various  sensor  bearing  errors,  a  priori  state  estimates  and  initial  error 
covariance  matrices  on  filter  accuracy  and  convergence  time  are  investigated.  Also,  the 
effect  of  target  maneuvers  on  filter  stability  is  analyzed.  Basically,  the  algorithm 
performs  three  functions: 

1.  The  target  and  sensor  tracks  are  generated. 

2.  Noisy  bearing  observations  are  simulated  using  a  random  number  generator. 

3.  The  noisy  measurements  are  processed  by  the  Kalman  filter  algorithm  to 
generate  estimates  of  the  target's  state. 

B.  TARGET  TRACK 

As  mentioned  in  Chapter  2,  three  target  track  scenarios  are  investigated: 
nonmaneuvering,  gentle  turn,  and  hard  turn.  In  all  three  cases  the  initial  target  position 
is  (410  nmi,  430  nmi)  with  X  and  Y  velocities  of  -400  knots  and  -  380  knots 
respectively. 

C.  GENERAL  SIMULATION  SCENARIO 

The  overall  purpose  of  this  simulation  is  to  be  able  to  track  an  inbound  enemy 
aircraft  before  it  flies  within  300  nmi  of  the  high  value  unit.  By  using  two  sensors  which 
ure  essentiaii}  abie  to  peek  '  over  the  norizon,  a  tong  range  OTH  lignter  intercept  of 
the  target  aircraft  may  be  accomplished.  For  all  simulation  runs,  an  initial  target  range 
of  600  nmi  is  chosen.  This  allows  the  sensors  to  passively  track  for  thirty  minutes,  and 
it  enables  fighter  intercept  to  occur  beyond  450  nmi  of  the  HVU,  depending  on  the 
fighter's  initial  position  and  fuel  state.  The  target  aircraft  is  also  assumed  to  be  flying 
inbound  at  approximately  600  knots. 


i.  Algorithm  Flow 

The  algorithm  can  be  broken  down  into  the  following  steps: 

1.  Define  the  true  target  track. 

2.  Define  the  observer  tracks. 

3.  Enter  a  priori  estimates  Xqj^j,  P0|_t,  and  Rq.  Enter  bearing  error  variances  2 
and  <r22- 

4.  Compute  the  noise  free  bearings  from  each  sensor  to  the  target  for  each  time 
interval. 

5.  Compute  random  sensor  bearing  errors  using  computer  generated  normal 
distribution. 

6.  Add  the  random  bearing  errors  to  the  noise  free  bearings  to  create  noisy 
bearing  measurements. 

7.  Compute  the  noisv  (x.y)  position  that  results  from  the  intersection  of  two  noisv 
LOBs. 

S.  Input  this  noisy  (x,y)  measurement  into  the  Kalman  filter  algorithm. 

D.  TARGET  TRACK 

As  mentioned  in  Chapter  2,  three  target  track  scenarios  are  investigated: 
nonmaneuvering,  gentle  turn,  and  hard  turn.  For  all  scenarios,  the  initial  target 
position  is  (410  nmi,  430  nmi)  with  x  and  y  velocities  of  -400  knots  and  -  380  knots 
respectively.  For  the  scenarios  where  the  target  maneuvers,  a  value  is  input  for  the  time 
that  the  maneuver  is  to  take  place.  Also,  values  for  the  x  and  y  velocities  are  input  for 
the  second  log  of  the  target  track.  It  should  be  noted  that  the  turn  radius  of  the  target 
is  not  taken  into  account  in  the  target  track,  for  at  the  extreme  distances  being 
investigated,  target  maneuvers  almost  appear  as  point  turns. 

E.  OBSERVER  TRACKS 

The  observer  tracks  each  begin  at  295  nmi  on  their  respective  axis  and  travel 
inbound  at  420  knots.  These  observer  tracks  were  chosen  to  be  inbound  to  represent  a 
more  realistic,  worst  case  type  scenario.  Ideally,  it  is  desired  to  have  both  observer 

t-nr-W  r*  •  to  nr^ioyo  °lrHr'c<t  p  2  C r'*  \i  ’  C  V. ! n  r  LOB  *  A  W  C  . 

constraints  and  maximum  on-station  time  for  the  observer  aircraft  are  important 
practical  considerations  that  must  be  taken  into  account. 

F.  INITIALIZATION 

In  the  first  series  of  simulations,  different  combinations  of  the  initial  state 
estimate  Xgj^  and  the  initial  error  covariance  matrix  P0|.j  are  tested.  For  the  first 
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simulation,  and  the  one  by  which  the  other  simulations  are  compared,  the  a  priori  state 


estimate  is 


400  nmi 
420  knots 
400  nmi 
420  knots 


and  its  associated  initial  error  covariance  matrix  is 


(fOnmi)^ 


?oH  = 


(50kts)“ 

0 


f50nmiV* 


(50kts)‘ 


The  initial  measurement  error  covariance  matrix  for  the  one  degree  bearing  error  case 


R*  = 


(7nmi)2 

(onmi)2 


(5nmi)2 

(7nmi)2 


G.  NOISY  BEARING  GENERATION 

The  Box-Muller  method  is  used  to  generate  normally  distributed  bearing  errors. 
Basically,  it  is  a  mapping  technique  that  uses  an  algebraic  identity  to  establish  a  one  to 
one  relationship  between  a  uniform  random  variable  and  a  normal  random  variable. 
Two  random  LY0,1)  numbers,  Uj  and  L’2»are  transformed  into  independent  N(0.1) 
random  numbers.  Nj  and  N,  using  the  equations 


N,  =  (  -  21nL  j)  *  cos  2JtL'2 


N,  *  (-21nU,)  ‘sin  2rrU- 


Figure  4.1  Normally  Distributed  Bearing  Error. 


Figure  4.1  presents  a  histogram  showing  the  normal  distribution  of  the  bearing  error. 
These  normally  distributed  random  numbers  are  then  multiplied  by  the  standard 
deviation  of  measurement  error  for  each  sensor  to  produce  two  independent  normally 
distributed  bearing  errors  for  0j  and  0,. 


V.  SIMULATION  RESULTS 


A.  INTRODUCTION 

The  purpose  of  this  chapter  is  to  show  through  various  scenarios  the  effect  of 
difFerent  initial  state  estimates  and  measurement  noise  levels  on  the  stability,  accuracy, 
and  convergence  time  of  the  algorithm.  In  the  following  pages,  fourteen  simulations 
involving  three  scenarios  are  presented.  As  shown  in  Figure  2.4,  the  three  scenarios 

A 

include  a  nonmaneuvering  target  track,  a  target  track  with"gentle  turn,  and  a  track  with 
a  hard  tum.  The  first  scenario  provides  the  reference  with  which  other  cases  may  be 
compared.  Unless  otherwise  noted,  all  simulations  use  a  two  second  time  interval 
between  measurements.  Also,  all  of  the  simulation  results  depict  the  cases  of  one 
degree  and  five  degree  sensor  bearing  errors.  It  should  be  pointed  out  that  in  order  to 
isolate  the  effect  of  various  parameter  changes,  a  single  random  number  seed  is  used 
throughout  to  represent  a  specific  noise  history.  There  has  been  no  attempt  to  create 
statistics  based  on  ensemble  of  noise  histories  due  to  the  extreme  computational  time 
required. 


B.  TYPES  OF  GRAPHS 

Five  graphs  are  used  in  all  simulations.  These  include  the  x  and  y  positional 
errors,  the  x  and  y  velocity  errors,  and  the  percent  range  error.  For  the  case  of 
positional  errors,  the  updated  state  estimate  of  x  and  y  position  is  subtracted  from  the 
target's  true  x  and  y  position.  Likewise,  for  the  case  of  velocity  errors,  the  updated 
state  estimate  of  velocity  is  subtracted  from  the  target's  true  x  and  v  velocity.  Range 
percent  error  is  computed  as 


Range  Percent  Error 


tRr-Rr/ 
R 


where  Ry  denotes  the  target's  true  range  from  the  origin  and  Ry  is  the  updated 
estimate  of  target  range  using  the  updated  state  estimate  for  the  x  and  y  positions.  In 
some  simulations,  the  measurement  residual  error  is  plotted.  The  measurement  residual 
is  defi..  d  as  the  difference  between  the  actual  noisy  measurement  and  the  predicted 
state  estimate.  It  may  be  expressed  as  the  quantity 


C.  SCENARIO  1 

Scenario  1  consists  of  ten  simulations  that  demonstrate  the  effect  of  various  a 
priori  estimates,  measurement  noise  levels,  and  time  intervals  between  measurements 
on  filter  performance.  In  all  ten  simulations,  the  target  is  on  constant  course  and 
speed.  Figure  5.1  illustrates  the  target's  true  track  along  with  noisy  measurements. 
Note  by  the  scale  that  only  a  portion  of  the  First  quadrant  is  depicted.  In  the  first 
simulation,  the  initial  difference  between  the  true  target  state  and  the  initial  state 
estimate  is 


iSr.  "  £o/-|  = 


10  nmi 
20  kt 
30  nmi 
40  kt 


and  the  a  priori  error  covariance  matrix  is 

jjjoj  O  o  O 
o  (SOkif  O  o 
o  o  (50  J  o 
o  o  o  (50tff 

Overall,  it  can  be  seen  that  for  the  one  degree  bearing  error  case,  the  algorithm 
tracks  quite  well.  Referring  to  Figure  5.1,  the  x  velocity  error  initially  gets  worse  before 
it  gets  better.  It  is  not  until  after  five  minutes  have  elapsed  that  the  x  velocity  error  is 
less  than  the  a  priori  estimate.  As  can  be  seen  from  Figure  5.1,  the  tracking  accuracy 
for  the  five  degree  bearing  error  case  is  fair.  The  one  degree  bearing  error  case 
definitely  demonstrates  quick  and  accurate  filter  convergence;  the  fisc  degree  bearing 
case  seems  to  meander  almost  randomly.  The  sudden  rise  for  the  five  degree  case  seems 
to  be  an  anomalous  disturbance.  The  x  and  y  velocity  gains  are  directly  related  to 
bearing  accuracy;  the  higher  the  accuracy,  the  greater  the  gain.  For  the  five  degree 
bearing  error  case,  the  velocity  gain  never  exceeds  0.2. 

The  following  nine  cases  are  basically  variations  of  the  first  case.  Table  1  lists 
the  parameters  that  have  been  changed  for  each  case. 


TABLE  1 

SCENARIO  PARAMETER  CHANGES 
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Figure  5.4  APXHAT  =  430  -540  120  -50.  with  R  Matrix. 


VUC'Crrr  UWOR  (in  K1)  x  ERROR  (in  HU) 


Figure  5.5  Same  as  Case  3,  Uncorrelated  R  Matrix. 


Figure  5.8  APXHAT  =  200  -150  480  -500  P=  105I. 
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VI.  CONCLUSIONS  AND  RECOMMENDATIONS 


A.  CONCLUSIONS 

The  purpose  oi  this  thesis  was  to  investigate  the  two  sensor  bearings  only  passive 
tracking  problem  using  Kalman  filtering  techniques.  A  computer  simulation  was 
developed  to  generate  the  target  track  and  the  noisy  bearing  observations  from  each 
sensor.  F  ilter  performance  was  exceptional  for  the  nonmaneuvering  target  case.  With 
one  degree  sensor  bearing  error  and  two  second  measurement  intervals,  the  filter  was 
able  to  consistently  track  the  target  to  within  one  quarter  of  one  percent  range  error  in 
the  first  five  minutes.  As  was  expected,  filter  accuracy  was  degraded  as  bearing  error 
was  increased.  The  tracker  performed  reasonably  well  for  sensor  bearing  errors  as  high 
as  eight  degrees. 

For  the  case  of  a  maneuvering  target,  filter  performance  was  marginal.  Filter 
convergence  to  an  accuracy  attained  prior  to  the  target  maneuver  did  not  occur.  The 
use  of  a  state  excitation  covariance  matrix  by  itself  was  not  sufficient  enough  to 
properly  account  for  target  maneuvers.  What  is  needed  is  a  reliable  zig  detector  that 
quickly  recognizes  target  maneuvers  so  that  the  filter  gains  may  be  reinitialized.  The 
problem  of  detecting  target  maneuvers  is  not  trivial.  At  long  ranges,  error  ellipses  may 
be  twenty  to  forty  times  larger  than  the  actual  distance  the  target  has  moved.  Sifting 
out  a  bona  fide  target  maneuver  from  these  extremely  noisy  measurements  is  quite 
difficult.  Determining  a  target  maneuver  by  attempting  to  find  a  pattern  in  the 
measurement  residuals  is  only  successful  if  the  time  between  measurements  is  greater 
than  thirty  seconds.  A  drawback  to  this  approach  is  that  filter  accuracy  is  degraded 
because  fewer  measurements  arc  being  processed. 

From  the  simulation  runs  it  was  found  that  the  most  influential  factors  in 
determining  tracking  accuracy  and  speed  of  convergence  were  the  sensor  bearing 
accuracies  and  the  time  between  measurements.  Factors  that  contributed  to  a  lesser 
extent  included  the  accuracy  of  the  initial  state  estimate  along  with  its  associated 
degree  of  confidence  and  the  positions  of  the  sensors.  Inaccurate  a  prior;  information 
did  not  degrade  the  filter's  accuracy,  it  only  increased  the  time  for  convergence.  T liter 
accuracy  improved  as  the  lines  of  bearing  came  closer  to  being  perpendicular. 


B.  RECOMMENDATIONS 

This  study  is  by  no  means  complete.  Some  areas  for  further  study  include  the 
following: 

1  Run  an  entire  ensemble  of  simulations  (perhaps  1000  runs)  to  generate  reliable 
statistics  on  the  filter's  performance. 

2.  Investigate  more  fully  a  method  to  detect  target  maneuvers  so  that  adaptive 
control  techniques  may  be  used  to  alleviate  the  problem  of  filter  divergence. 

?.  Examine  the  utility  of  using  more  sensors  to  cover  a  comparable  sector.  Are 
more  sensors  necessarily  beneficial? 

4.  Perform  the  simulation  using  a  different  coordinate  system  (such  as  polar 
coordinates)  and  compare  the  results  to  those  obtained  using  a  Cartesian 
model. 
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APPENDIX  A 

DERIVATION  OF  MEASUREMENT  ERROR  COVARIANCE  MATRIX 

In  this  appendix  the  measurement  error  covariance  matrix  Rk  is  derived. 
Recalling  the  measurement  equation  from  Chapter  3.  the  measurement  noise  vector  vR 
is  assumed  to  be  Gaussian  and  zero  mean  with  variance  Rk.  That  is, 


\  ~  Ni0-Rk| 


(ft- 1) 


The  purpose  of  Rk  is  to  statistically  describe  the  noisiness  of  the  x  and  y  measurements 
obtained  through  the  intersection  of  noisy  lines  of  bearing.  Basically,  the  2  by  2 
measurement  error  covariance  matrix  describes  this  noisiness  by  displaying  the  variance 
and  covariance  of  the  noisy  x  and  y  measurements  in  terms  of  each  sensor's  bearing 
measurement  and  accuracy.  Referring  to  Figure  A.l,  the  position  (Xy.Yy)  represents 
a  possible  true  position  of  the  target  based  on  noisy  sensor  bearing  observations,  8j 
and  0,.  The  position  of  the  target  (Xy.  Yy)  is  a  jointly  distributed  random  variable 
whose  expected  value  coincides  with  the  intersection  of  the  bearing  lines. 
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To  develop  the  relationship  between  Xy  and  Yy.  the  LOB  s  from  each  sensor 
may  be  expressed  in  the  general  form  for  the  equation  of  a  line: 


X  8t  +  y  cx>s  $t  —  x,  sm  9,-0 
x  c os8x  *•  y  S'«  ~  *»"  &x  -  O 


(A-2) 

M) 


The  distance  from  the  position  (Xy,  Yy)  to  each  sensor  line  of  bearing  is  denoted  by 
d!  and  d.,  for  each  sensor  LOB  respectively.  From  the  problem  geometry  and  by  using 
the  equation  for  the  distance  between  a  point  and  a  line,  the  displacement  distances  d. 
and  d,  may  be  expressed  as 


=  -£(Xr-*,)  »•’»  3  *  Yre««S,J 

it  =  j[  xT  e, ♦  (rT-y.)  «•"  e.] 


(A-*) 

(AS) 


Since  both  sensor  bearing  errors  are  assumed  to  be  Gaussian  zero  mean  random 
variables  with  bearing  variances  a  2  and  ff,2.  it  follows  that  the  displacement  random 
variables  d[  and  d2  are  also  zero  mean  Gaussian  with  displacement  variances  and 
<r2/  respectively.  Figure  A. 2  illustrates  the  relationship  between  the  displacement 
variance  and  the  sensor  bearing  error  variance. 


Figure  A. 2  Relationship  Between  Bearing  and  Displacement  Errors. 


jwv^viru  n1  ty  w\t  wv^^vw^’ 


In  this  figure,  the  bearing  error  standard  deviation  for  sensor  1,  is  expressed 
in  degrees  or  radians  whereas  the  displacement  error  standard  deviation  for  sensor  !.  <J: 
,  is  expressed  in  nautical  miles.  They  are  related  by 


<Tj/  =  r,  tan  <j, 


(A't) 


where  ^  is  the  approximate  distance  from  sensor  1  to  the  target  in  nautical  miles. 

Therefore,  the  displacement  distances  dj  and  d2  are  normal  random  variables  that 


mav  oe  written  as 


N(0.  ffj/) 


-  N(0.  <r,r) 


(A- 7) 
(AS) 


Having  described  the  displacement  random  variables  dj  and  d2  from  sensor  1  and 
sensor  2  lines  of  bearing,  equations  A-4  and  A-5  may  be  rewritten  as 


XT  *  Yr  e-oi  6t  -  X,  *m  6,  *  N, 

XT  c os  *  Yr  $.v»  ^  *  y*  6Z  * 


<&-?) 

(A-iol 


where  N(  =  N(0,  <r j-?)  and  \,  =  N(0.  cj).  Solving  equations  (A-9)  and  (  A- 10)  for 
X-r  and  Yy  yields: 
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Y  -  x,  Sin  9,  CQ1&L  ~  it  *‘*&t  *‘"6,  r  hi,  cot&j  -  Nj 
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By  noting  that  Nj  and  N,  are  zero  mean,  the  expected  value  of  their  product  is  the 
product  of  their  means.  That  is,  =  E  [nJ  E  [n.,J  =  0.  Using  this  fact, 

the  covariance  between  the  random  variables  Xy  and  Yy  is  simplified  to 


Co \( Xy ,  'l  y)  —  A,  B.,  (Jj t  ■+•  Aj  Bj  C,/ 


(A-ZO) 


Substituting  equations  fA-lS),  (A-16),  and  (A-20)  into  equation  (A- 1 7)  enables  the 
measurement  error  covariance  matrix  R  to  be  written  as 


At  r*  *■  ,4,  B,  rf  <rf  *  B* erf 


Lastly,  substituting  the  vaiues  for  A2  and  A3  into  the  above  equation  yields  the  final 
expression  for  the  measurement  error  covariance  matrix 
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APPENDIX  B 

SIMULATION  PROGRAM  LISTING 


V  KALMAN 

ft  THIS  PROGRAM  IS  A  TWO-SENSOR  KALMAN  FILTER  TRACKING  ALGORITHM. 
a 

ftTHE  FOLLOWING  IS  A  LIST  OF  THE  PRINCIPAL  VARIABLES  USED : 

ftAPXHAT . A  PRIORI  STATE  ESTIMATE  XHAT 

ftSEl  ,BE2 . NORMALLY  DISTRIBUTED  BEARING  ERRORS 

ftDT . TIME  STEP  (IN  HOURS) 

ft  ERR . ACTUAL  POSITION  ERROR  (TRUE-PREDICTED  ) 

ftG . KALMAN  GAIN 

ftH . MEASUREMENT  MATRIX 

ftNTHETAl  ,NTHETA2  .  .NOISY  BEARINGS  FROM  SENSORS  1  AND  2  TO  TARGET 

ft  NZ . MEASURED  X.Y  POSITION  (NOISY ) 

ftP . ERROR  COVARIANCE  MATRIX 

ftPHI . STATE  TRANSITION  MATRIX 

ftQ . STATE  EXCITATION  COVARIANCE  MATRIX 

ftR . MEASUREMENT  NOISE  COVARIANCE  MATRIX 

ft  RNGPCERR . PERCENT  RANGE  ERROR 

aR2D . RADIANS  TO  DEGREES 

ft  TKM . TIME  VECTOR  ( IN  MINUTES  ) 

ftVX.VY . TRUE  TARGET  VELOCITIES  IN  X  AND  Y  DIRECTIONS 

a  7X1  ,VY2 . SENSOR  1  AND  SENSOR  2  VELOCITIES 

ftXHAT . STATE  ESTIMATE 

ftXTK ,  YTK . VECTORS  OF  TRUE  TARGET  POSITIONS 

ftXlK,Y2K . VECTORS  OF  TRUE  SENSOR  POSITIONS 

ft 

a  *********************************************************** 

ft  INITIAL  CONDITION  INPUTS  i 

n  •  INPUT  DESIRED  RANDOM  LINK :  ' 

RLSA VE+URL+ 265067500 

°>  HOW  MANY  ITERATIONS  ARE  TO  BE  RUN  (K)?' 

K+ D 

'  ENTER  TRUE  TARGET  PARAMETERS :  XTO  ,  VXF ,  VXS ,  YTQ  ,  VYF ,  VYS ' 

TP.UESTATE+U 

XTO+TRUESTATElll 

VX+TRUESTATE [2  3] 

YTO+TRUESTATEim 
VY+TRUESTATE15  6] 

'  WHEN  IS  THE  TARGET  GOING  TO  TURN  (WHICH  ITERATION  NO .  ) :  • 

TURN+Q 

P'  NEXT  ENTER  SENSOR  1  AND  SENSOR  2  POSITION  AND  VELOCITY ' 

'  DATA  ASX  10,7X1  ,Y20  ,VY2  ' 

SENSPOS^U 
X 1 0-*-SENSPOS  [  1  ] 

VX1 +SENSPOS  2 
Y20-*-SENSPOS  3 
VY2<-SENSPOSl*l 
a 

TIME  STEP  TO  BE  USED  (DT ,  IN  SECONDS  )  ?  ' 

DT+ □ 

DTS+DT 
£>r«-£>r*3  600 

ft 'NO.  OF  POINTS  TO  INCLUDE  IN  THE  REGRESSION :  ' 


,i  i,|  t.i  1,4 


JJ*  Aa  _ _ 


61]  fiW?P<-0 


C62] 

[63] 

[64] 
LC  5  ] 
[66] 
[67] 
^  6  S  j 

[69] 

[70] 

[71] 

[72] 

[73] 

.743 

[75] 

[76] 


'  NOW  ENTER  ALL  A  PRIORI  ESTIMATES  AND  MATRICES :  ' 


'  INITIAL  GUESS  XHAT  ( FOUR  ELEMENTS  MUST  BE  ENTERED  )  : 
XHAT+C 

XHA1*  4  1  o  XHAT 
APXHAT*XKAT 


'  INITIAL  P  MATRIX  DIAGONAL  ELEMENTS  ( FOUR  ENTRIES  )  :  ' 
DIAGONAL* 0 

P* ((\4)o.  =  t4)x 4  4 p DIAGONAL 


[77]  o'  ENTER  OFF-DIAGONAL  POSITIONAL  AND  VELOCITY  COVARIANCES  (2  INPUTS ) :  ' 
[73]  OFFDIAG*  00 

[79]  P  [  1 ;  3  ] *P [ 3 ; 1 ] +OFFDIAGI 1 ] 

[80]  P  [  2  ;  4  ] *P [ 4 ; 2 J  +OFFDIAG [ 2 ] 

[81]  PSAVE+P 
L 82 3  o 

[33]  '  INITIAL  R  MATRIX  ( 4  NUMBERS  IN  THE  ORDER  UL  ,UR  ,LL  ,LR)  :  » 

[84]  P«-C 

[8  5]  RSAVE+R+  2  2  pP 

[87^0  SET  UP  SOME  VECTORS  NEEDED  TO  GENERATE  THE  Q  MATRIX. 


1  /  3  j 
[80] 
[81] 
[82] 
[33] 

[84] 

[85] 
[36] 
[87] 


[  8  7  ]  0  SET  UP  SOME  VECTORS  NEEDED  TO  GENERATE  THE  Q  MATRIX . 

[38]  RO((oll*(4x360g)l*2 

[89]  fiFl«-  12  1  '2  2  4  2  4 

[90]  oFl«-Fl,-Fl 

[91]  fiF2«-  4  4  2  2  4  4  , 10p2 

[92]  nF3«-(8o4)  ,8+F2 

[93]  fiF4«-  43433232 

[94]  fiF4«-F4  ,F4 

[95]  o 

[96]  '  ' 

[97]  '  ENTER  MAX  BEARING  ERROR  IN  DEG .  FOR  THETA  1  AND  THETA 2  U2  INPUTS  )  :  ' 
l98]  B6«-Q 

[99]  fi 

-100-  o ************************************************************* 

[101]  o 

[10  2]  fi  INITIALIZED  STORAGE  VECTORS  FOR  GRAPHING  PURPOSES  ONLY 


[102 

[103 

[104 

L105 

[106 

[107 

[108 

[109 


IGVSTORE+QGSTORE+QVERRSTORE+QERRSTORE+QRESIDERRSTORE+ ( 2 , K+l ) p  0 
)RNGPCERRSTORE*QMSA VE+ < 1 , K+ 1 } p  0 


L  1 13 
[114 


[107]  fl  THE  FOLLOWING  OUTER  LOOP  IS  FOR  GRAPHING  THREE  SETS  OF  SENSOR  BEARING 
[10  8]  fi  ERRORS  ON  THE  SAME  GRAPH.  THE  TRACKING  ALGORITHM  IS,  IN  EFFECT,  BEING 
[10  9]  o  RUN  THREE  TIMES ,  WITH  EACH  RUN  USING  A  DIFFERENT  PAIR  OF  SENSOR 

[110]  fi  BEARING  ERRORS. 

[111]  fi 

[112 j  MAINLOOP* 1 

[113]  TOP:BRGERR+B 6[(  1 +2*MAINLOOP) , 2*MAINLOOPl 

[114]  P+PSAVE 

[115]  R+RSAVE 

[116]  XHAT+APXHAT 

1117]  A.l+BRGERRil'} 

118]  A2+BRGERR12] 

119]  fi 

120]  fiSFr  UP  Q  MATRIX  INITIALLY  TO  BE  A  4X4  MATRIX  OF  ZEROS. 

121 J  C<-4  4p0 
122]  fi 

123 j  o**************************************************************** 


[115; 

[116, 


:ii7] 
;ii8] 
,119] 
.120] 
:i2i  j 
’122] 
.123  j 


[124 

[125 


[12  5]  b  THE  PURPOSE  OF  THIS  PROGRAM  SEGMENT  IS  TO 

[126]  0  ESTABLISH  TRUE  TARGET  TRACK  (.WHICH  INCLUDES  TWO  LEGS)  AND  SET  UP 

[127]  0  SENSOR  1  AND  SENSOR  2  TRACKS.  NOISE-FREE  BEARINGS  FROM  EACH  SENSOR 

[128]  fi  TO  THE  TARGET  ARE  COMPUTED .  NOISY  ZERO-MEAN  NORMALLY  DISTRIBUTED 

[129]  fi  BEARING  ERRORS  ARE  GENERATED  AND  THEN  ADDED  TO  THE  NOISE -FREE 

1 1 3  0  3  0  BEARINGS .  FROM  THE  INTERSECTION  OF  THESE  NOISY  LOB  '  S  ,  THE  NOISY 


mmmm 


fill] 

till: 

U34] 
*135  J 
wl35  j 
C137] 
£138] 
£l3S 
£140  J 
£141] 
L 142  j 
[143] 
[144  1 
[145] 
L 146  J 
[147] 
l148] 
L14SJ 
150 

[151] 

[152] 
[133] 

£154] 

1 155] 
C 1 56  j 
£157] 
[158] 

.153  j 
,160] 
[161] 
.162 
Pl63  J 
l164] 
£165. 

E1665 

Pl68 

Pies] 

l171  J 

[172] 

[173 

£174. 

[175. 

£176. 

[177. 

t1783 

£179, 

ffl\ 

ill] 

£185] 
Lies] 
[187] 
£188] 
[  1 8  9  ] 

ciSij 

fill 

Cl94l 
£19  5] 
[1.36] 
£197] 
£19  8] 

F  A  ft  O.  1 


«  iX.Y)  POSITION  OF  THE  TARGET  IS  COMPUTED  AND  STORED  FOR  LATER  USE 
fl  IN  THE  TRACKING  FILTER  AS  THE  TARCET '  S  '  MEASURED  '  POSITION  FOR 
a  THE  KTH  TIME  ITERATION . 

a  SET  UP  SOME  INITIAL  CALCULATIONS : 

TK*-DT*0. \K 
IKM*-TKx&0 

XTKF*-X TO+VX [ 1 1 *DT* 0 . i TURN 
XTKS*(  l+XTKF)  +  VXZ2]xDT*\  ( K-TURN ) 

XTK+XTKF , XTKS 


Y IKF+ Y£0 + VY  [  1 1  x  DT*  0  .  \  TURN 
YTKS*(  l  +  YTKF)+VYZ2]xDT*\(K-TURN) 


YTK+YTKF , YTKS 

XlK+XlO+VXlxTK 

Y2K+Y2Q+VY2xTK 

p 

R2D*-180*ol 

LVX*-X1K=XTK 

LVY*-Y2K=YTK 

0 


THETAlK+i 

l(XlK<XTK)*ol 

)+l3°( 

THEIA2K+\ 

l  (Y2K<YTK)*ol, 

)+  3 0  ( 

p 

THETA1K* 1 

[LVXx 0.5xol )+l 

[~L7X) 

THETA2K*-i 

,L7Yx0. 5xol )+i 

(~£yy) 

THETAlK+CLVXxQ .5xol U (~LVX )*THETA1K 
THETA2K*-{LVY* 0.5xol  )+ (~LVY )xTHETA2K 

pCONTINUE  WITH  CALCULATIONS  l 

0 DATAPOINTS* <2 .NRP )p 0 
RNCPCERRSTORE+MSA VE+ 0 
RESIDERRSTORE+NZ*- 2 1 d0 

GVSTORE*-VERRSTORE*-ERRSTORE*-BSTORE*-GSTORE*NZFIX*-{2  ,K+1  )p0 

XHATSTORE*  41  pO 
P  ST  ORE*-  4  4  pO 

H*-  24pl0000010 
PHI*-(\ 4  )«.=i4 
PHIZl\2]*-DT 
PHIZ3  ;4j«-Dr 
n ACCEL*- 0 . 5*DT*2 

p GAMMA*  4  2  pACCEL  ,0  ,DT ,0 ,0  tACCEL  ,0  ,DT 
I*-Z\ 4)o.  =  i4 

p 

0************************************************************ 
p  START  MAIN  LOOP: 

p 

N*  1 

P 

P 

LOOP : G+P+ .  x  (  + . xfflfl+ff + .xP+.x$H 

p 

p  'KALMAN  GAIN:  ' 

p 


GVSTORE Zl 1 N2+G12 ill 
GV STORE  12  :N}*-G L1* ;  2  J 
GSTOREZl;Ni*-GZlil ] 
GSTORE  L  2  ;  •«-£  L  3  ;  2  j 


p  G 
a 

P*-(I-C+.*H)+.xP 
PSTORE+PSIORE ,  [  0 . 5  x  l  + 1  < JV]  P 

p 

a 'UPDATED  P:  ' 


vS'y 


S* 


[201] 

l202] 

C203] 

[204] 

[205] 

[206] 

[207] 

[208] 

[209] 

[210] 
[211, 
[212] 
[213] 
£214] 
1 2 1  5  j 
[216] 
[217] 
[216] 
[219] 

[  2  2  0  j 
[221] 
[222] 

[223] 

[224] 
£225] 
[226] 
[227] 
L228] 
[229] 
1 230  J 
[  2  3  1  ] 
[23  2] 
[233] 
[234  , 
[23  5] 

[236] 

[237] 

I  : 
?SSj 

[242] 
[242] 
[244  1 

[245] 

[246] 

[247] 

V?  4  =  , 
[2  =  0  J 
[  2  5 1  ] 
L  252  j 

[256] 
[2  5  7] 
[2  53] 
[2  59. 
[260] 
[261] 
2|2] 
[26  o, 

2o  5  ' 

Uc7, 
*268  j 

[269] 
[  2  7  0  j 


ZK<r  2  1  oXTKZNl  ,YTKIN] 
a  '  TRUE  TARGET  POSITION ' 
aZK 

o  THE  NEXT  SECTION  GENERATES  2  NORMAL  BEARING  ERRORS. 

U+(? 2cl0*10 )*10*1C 
SSQ+(  2*®E[1]  )*C  .  5 
SPR1+A1* lR2Dxl .95) 

SdR2*-A2*  (  D2D*1  a6) 

ESiOEE]u)h+-BEi+SPR\*SSQx2o(.U':2'\x2*ol  ) 
BSIOREl2iN]<rBZ2<rSPR2*SSQxlc(UL2]x2xol ) 

NTUETA1+TRETA1KIN] +BE1 
NTHETA2+THEIA2KZN*  +BE2 

SAl+loNTHETAl 
CAl*-2oNTHEIAl 
SA2+1QNTHETA2 
CA2+2oNTHETA2 
D+2o (NTHE1A1+NTHETA2 ) 

°NZFIX  [  1 ;  /7]  -*-NZ  [  1 ;  ]-«-  ( CY2KZN1  *SA  2*CA  1 )- CXIKLN]  *SAl  xSA2  )  )*D 
NZVIX[2%,N]  ■*-NZl2j  j  «-(  (X1KLJV]  xSAlxCA2  )- lY2KiNl  *SA2*SA1 )  )*D 
qNCISE]1;N]^XTKLN] -NZFIXtliN] 
a  NOISE  1 2  iNl  +YTKZN*  -NZFIX  [  2  ;  N] 
p  '  TRUE  TCT  X ,  Y  POSIT  MINUS  NOISY  X ,  Y  POSIT ' 
o  NO I SEL;N] 

p 
p 

°RESIDERR+NZ -H+ .  *XHAT 
XHAT+XHAT+C+ . xRESIDERR 
a 

°XHATSTORE+XHATSTORE ,  XHAT 

aRESIDERRSTORE+RESIDERRSTORE ,  RESIDERR 

aDATAPOINTS+DATAPOINTS ,NZ 
aDATAPOINTS+DATAPOINTS ,  10  10  EXRAT 

a DATAUSE+ ( 2 . -NRP ) ♦ DATAPOINTS 
aSUMX++/DATAUSElli] 
qSUMY+  +  / DATA USl[_2  ;  ] 
aSUMX2++/DATAUStl 1 ; ] *2 
aSUKXY<-+/DATAUSE*  1 :  ]  *DATAUSEZ 2  :  ] 
aDEN0MINAT0R+(NP.P*SUMX2  )-SUMX  +  2 
aM<r  (  (N  RP*SUMXY)-SUMX*  SUMY)*  DENOMINATOR 
aMDEC+-R2Dx  ( ol  )♦  3 oN 
a  MSA VE+KSA VE , MDEG 

VERRSTOP.E [  1 ; N]  +VX [  1  +N>TURN+1  j  -XRATZ2  ;] 

VERRSTORE [ 2 ; NJ ♦  7Y ! 1 +N>TURN+ 1 j -Xtf£r[4 ; ] 

P.TRUE+(+/ZK*ZK)*G  .5 
EX-»-  1  C  1  0  /XHAT 
ErMr«-(+//?X*EX)*0.5 
RNCPCERP+ 10  0  *  (  *RTRUE )  *  lB27?C/E-/?tfAr 
RNGPCERRSTQRE+RNGPCERRSIORE , RNGPCERR 
a 

a  '  UPDATED  XHAT :  ' 
o  XEAf 

EF.R+ZK-  2  1o  ,X«4rCl  3  ;] 
o  '  ERROR  VECTOR :  ’ 

ERR  STORE  [  l ;  JV[  «-E/?tf  [  1 ;  ] 

ERR STORE i 2 \Nj+ERR [2 ; j 
oEEE 

p 


:ORE ,  RNGPCERR 


%  -N  J.V.V  A  - 


[271 
[272 
L  2  7  3 
[274 
[275 
[276 
[277 
[278 
[279 
[280 
[281 
[282 
[283 
[284 
[285 
L  2  86 
[287 
l283 
[289 
[290 
[291 
[292 
[293 
[294 
[295 
[296 
[297 
[298 
[299 
[300 
301 
[302 
[303 
[304 
[305 
[306 
[307 
[308} 
[309, 
[310, 
[311. 

1312, 
313 
314, 
315, 
316, 
317, 
318 
>,319, 
[3  20  j 
[321  j 
[322, 
[  3  2  3  j 
[32u 
[325 
.326, 
[327. 


P«-«+PffI+ .  xp+ .  x$PHI 


p  'PREDICTED  P:  ' 
a  P 

p 

XHAT*PHI+.xXHAT 

p 

p 


'  PREDICTED  XRAT: 


p  XHAT 

lx2*XHATZ2\'\ 

PX4<-Xtfim4;] 

pXA«-X4,X4,X2,X2,X4,X4,X2,X2,X2,X2,X2,X2,X2,X2,X2,X2 
PXB-»-X4.X4fX4,X4,X4,X4,X4,X4,X4,X4,X2,X2,X4,X4,X2,X2 
aQTERMS+C*Fl*XAxXB*DTS*F* 
aQ*  4  u  oCPEPMS 

p  CALCULATE  TERMS  IN  THE  R  MATRIX : 

R1*(XHATZ3 ; ] *2 )+(XHATZ 1 :J~X1KlN2 )*2 
SIC12+R1* (3oAl*R2Dxl. 96 )*2 
R2+(.XHATLlil*2)+<.XHATl3:l-T2KZNl  )*2 
SIG22*R2* (3oA2*R2Dxl . 96  )*2 

p 

D1*D*2 

UL*(  (.SIG12*SA2*2  )+ (SIG22*CAl*2  )  )*D  1 
LR*l  (SIG12xCA2*2  )  +  (SIG22*SAl*2  )  )*D  1 
CROSS*- ( (SIG12*SA2*CA2 )+(SIG22xSAl*CAl ) )*D 1 


R*  2  2  p  UL , CROSS , CROSS , LR 
p  '  R  MATRIX :  ' 


p  R 

p  '  * 

p  '  *************************************** ' 

p  '  ITERATION  NO .  '  ,9  (N* l) 

p  *  ' 

N*N+ 1 

*(N<K+l)/LOOP 


p  ********************************************************* 


LCM-*-  0. 5xi  +  i< MA  IN  LOOP 
QGV STORE+QGV STORE ,  [SQM] 

QGSTORE+QGSTORE , lLQMj  GSTORE 
qVERRSTORE+QVERRSTORE . [SCMD  VERRSTORE 
QERRSTORE+QERRSTORE .  ZLQM1  ERRSTORE 
QRESIDERRSTORE*QRESIDERRSTORE,ZLQMl  RESIDERRSTORE 
RNGPCERRSTORE* ( 1 , oRNCPCERRSTORE ) o RNGPCERRSTORE 
QRNGPCERRSTORE*QRNGPCERRSTORE ,  ZLQH]  RNGPCERRSTORE 

p  msa  y£>  ( 1 ,  p  msa  yp  5  o  msa  y  e 

aQM3AVE*QMSAVE ,ZLQM1  MSA  VE 
MAINLOOP*MAINLOOP+ 1 
□PS+PSSAyP 

*(MAINLOOPZ 0 . 5xpB6 )/T0P 
*  COMPLETE. ' 


N  ■'  -V 


mew 
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